float64 curvature
float64 phi
int32 cost
